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Reduce the vehicle speed to help reduce road 
departure 



Control the vehicle yaw to return to the road by 
steering or brake control 
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Control the vehicle yaw to reduce heading angle 
by steering or brake control 
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Alert the driver by auditory and tactile warning 
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Calculation of the Lateral speed at Deviation 




Calculation of the headinR angle at deviation 
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Band-Pass-Filter for concrete roads 
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Start 



Taking Steering wheel angle sensors output 
* 



Calculating Steering wheel angle: G 
Calculating Steering wheel speed: d9/dt 



Taking G sensors output Gin 



Passing Gin data through BPF: Gbpf 
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Running on Rumble Strips 
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to vehicle speed 
The pattern of nimble strips: cycle distance ; 30.48cm ( lfoot) 
140~km/h 128 Hz BPF#1 
120~140km/h 109 Hz BPF#2 
100~120km/h 91Hz .BPF#3 
80~100km/h 72HzBPF#4 
6O~80km/h 55 Hz BPF#5 
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Taking G sensor output: Gin 



Taking Vehicle Speed 
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Select BPF#l-#5 
i 



Passing Gin through selected BPF#x 




Running on Rumble Strips 
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Taking Steering Wheel Angle Sensors output 
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Calculating steering wheel angle: 9 
Calculating steering wheel speed: dd/dt 
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Taking Steering Torque SensoA output 
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Calculating Steering torque by Driver. Trq 
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Taking Brake pedal Swjtcr/output 
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Taking Steering wheel angle sensor output in 
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Taking Steering torque sensor output in 
j 



Taking Brake SW .output in 
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Detecting the deviation direction by the 
digital map and CPS 
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Steering torque is added constantly to 
return to the 1 



torque is added constai 




> Refer to the flow chart- 
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Refer to the Flow chart 



Regarding other controls, Refer 
to the Flow chart 



Reduce added steering torque gradually 
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Reduce the torque demand for 
ENG Controller and AT controller 



Decelerate the vehicle speed 
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Reduce added brake force gradually 
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Return the torque demand to original 
demand gradually 



Return 





Refer to the flow chart 4? 0^ ^ 1 
| Release the pre-tension of each seat belt 
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Taking G sensors output in 
G-FR, GFL,GRR,GRL 



*1 Refer to the flow chart of Figs. 17 and 18. 
*3 Refer to the flow chart of Fig. 19. 
*4 Refer to the flow chart of Fig. 20. 
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The same flow of RH-side 
except replacing RH by LH 



Alert Driver by auditory and tactile warning 
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Fig. 22 
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Taking G sensors output in 
G-FR, G_FL 




*1: Refer to the flow i 
*2: Refer to the flow 
*3: Refer to the flow chart* 




Return 




Tuner starts: 
Measure: At 




p 



Calculate deviating speed: Dv & yaw angle: 0 
Dv «= Td / At (Td: Tread distance) 
e*tan* l (Td/(v * Ai) (v: Vehicle speed) 




the vehicle 
control gradually 
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Recognizing the road with Vision Sensor 
by detecting lane markings on the road 
Calculate host vehicle position 
or 

Calculate host vehicle position 
By Digital map and GPS 



Quite the vehicle 
control gradually 




Of 

*1: Refer to the flow chart 
*2: Refer to the flow chart 
*3: Refer to the flow cl 
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Yes 



Vehicle deviates to the 
opposite lane 



Vehicle deviates from the road 




Yes 



Control the vehicle yaw angle to return 
to the road by added Steering torque or 
Individual braking force. 



Yes 



Control the vehicle yaw angle to return 
to the own lane by added Steering torque 
and reduce vehicle speed. 
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Flow Cha 



Stan 




Recognizing the road with Vision Sensor 
by detecting lane markings on the road 
Calculate host vehicle position 
or 

Calculate host vehicle position 
By Digital map and GPS 



Increase damping force of front 
S/absorbers & decrease rear S/absorbcrs 




Raise vehicle height to original position 



Return S/absorbers to original Damping 
force 




*1: Refer to the flow chart < 
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